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(57) Abstract 

PROBLEM TO BE SOLVED: To provide an outside 
recognition device for a vehicle capable of switching an 
image processed object among a plurality of objects in 
proper timing according to circumstances and capable of 
reducing a computing load for image processing. 

SOLUTION: This outside recognition device for a vehicle 
is provided with a first certainty degree computing 
means 105 computing possibility that a selected object 
becomes an obstacle to own vehicle as a first certainty 
degree, a second certainty degree computing means 106 
computing possibility that a tracked object becomes an 
obstacle to the own vehicle, as a second certainty 
degree, an identical object determining means 1 07 
determining whether the selected object is identical to 
the tracked object or not and a tracked object 
selecting means 106 selecting an object to be tracked by 
an image processing object tracking means according to 
the first certainty degree and the second certainty 
degree when it is determined that the selected object is 
not identical to the tracked object 
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[ # fF m * <o m m ] 
[ at # * 1 ] 

*m*ixfc*9*(t««-a<J''^"c, emi-i oTitait^tftss: 1 o it an tR -r 5 & 
ft i- g -3 # > js^^s^^ii^^s^ii^-rs^^^iitR-rsii^^if^iS^^si:, 

[11*92 ] 

is * m 1 1= ie m <o m m m ^ m m m e 1- *3 ^ -c . 
a m m as * # is * » i t , 

b-t zMffimw-RmmmWio 
i § « * 9 3 ] 

ift * « i * (4 tit * m 2 tc ta m. <o * ran ffl ^ # s ft m m k *j ^ r „ 

mtzm i & b wi 2 mm& bm&&mmm&<o o ^ <r> >p t£ < b h 2 o«i ^ , in — #3 & 

[ fft*JS 4 ] 

ft * is 1 * v l it * ri 3 ©^t 1 mizum.fDMffimftwiE-mmmiz&is^x, 
iRts: b z&mb-t z>T$-mmtvnmmmw. 0 

l IS * 3S 5 ] 

fft # * 1 4^ L if * il 4 cd v -f ix 1 ^ fe*£ <£> Pi ffl fl- # MISt « t- *s v> T , 
i!fJfe£!$$S9{£ii!tR#{£<i. IlSfl^J;!) t ^ 2 itf|g©*i45fiv^ # , ill iR £ ix ^ <fc 

[ f ft * if 6 ] 

Ift * JS 1 f£ ^ L ft # JS 5 <75 V> -T n 7)> 1 *{CfS«0*pfffl^-#^lt^fi{C*5V^T, 

m m & m m ^ & iz . m b& 2mmm&&izmjEffi.£ v i>&^ b % . mviz 

1 1 ft * m 7 ) 

Ift * JS i /iv^LM*JS6 v> -f l «{c|E*©^:i^ffl^-#Blt^«(-*5V N T, 

[ » * * 8 ] 
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£§Bo 

[ HI * « 9 ] 

ft *i| l Li * 3S 8 ^ -f ft i ^1 k IE * co flr pf m ft # B !3s %Z S *5 v> T , 

miMi&mmm&tf t mm £ titz t # , m 1 * ft * * « * 2 is m s co & ft < n-* 

A« iSff ft ft J: 9 f& » I- (4 . !RSiifcft#«:ljRt8 :tS:»lltt5*pSiffl^*B 

[ i * * m 1 0 i 

IB * JS 1 ft ^ L ft * *I 9 co ^ -f ft 1 « iz IB ft co «: m m ft # B SS % ■ (- ^ T , 

iiw^ft^^f^fcia^^co^^^f^^ mvi & intiVo&<Dffi ( * 

meK) Jfifil^ » ^ co ^ f* g co tit ( * ti ) LT*^L. 

B ft fit a* IS ^ fc *J « £ ft tz fc S , »«S^fc*ff^«*i^ffi«i**r^ffi«S:*ft:ffi 

[ » * * 1 1 1 

ft * IS 1 ft ^ L ft * 3S l 0 co ^ -f ft rt> l 3Slc|E*^*P5ffl^#B**««-*3V^T, 

wiEtH;btt*ffi«ft£#&f4. ^ fttzmw^ t <o m^^m - ^ \± t mm ^ ft 
tz t # , 

1 W « « ct 9 fc S§ 2^mS^^^i^v^^^{c^4..ifi^^co^ft<o^^r^fiet«^r^{i 
B £ *3 f± H fc L T ^ ae L . 

1 1 Kit D fc#2*«*<D#a*«i^»^ictt/»«£ftfc«^© 

*M»««J:9fc352»{f£<z>;£as»5<, a> o . *i*«*4:JS2»«**K*JcgT*K[J: 
D fc fS » tt , I«$tif^*^»*f^]felti*^fil^fe*fil^ 

[ If * 31 1 2 ] 

» * « 1 4va«*5 1 1 co ^ 1" in 1 JS(cfS®co»:pfffl^#BiaSBi-*5V^r. 

stjt£m^^»:{iLS^:^^^(i. siRSftfcttflcfciisf^oflfcflcasra-- -c ft 1^ fc *u » £ ft 
fc fc s . 

smfiSJ:Hg2iifis^*^t< x o N ^ 1 mm & t m 2 $tit^^^^^f^fflct 

<9 S^^ftfc^^t^^^^O^^co^^tc^tL. #K fc 3 S *<B»J» 

±5*#fc«tt*a*ifc»fcfc6#«r*i^ 
5 *P5ffl'^#B»3S«o 

[ 0 0 0 1 ] 

[ 3£ W co s -r Z> ft W # BP ] 

7 ft fc* J: OfflE*v*otft&4fc*3C*Jc:JsllEi-awfcicJ: 9 . <t 9 it Jfgl^ft {£ E £ 
^£iji-£fcfcfcfc. jBStyfoo^ Fi«Ki*lfitt5i:Wffl^ffB*Sli:B 
■f 3 co fc £ o 
[ 0 0 0 2 ] 

[ « * co ft ffi ] 

o 

[ 0 0 0 3 ] 

r. co S e f* > #^?CJ: 9K**ftt5fftfti*«i^-/^**itt*ff»ttii: 
S^5#Pfi«i-5fc*, H«^a*Kiit-^5rfc^pr«gfcftSfcO-Cfc5 0 
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[ 0 0 0 4 ] 

[ 4* ffF X itt 1 ] 

# 5fl 5p 7 - 1 2 5 5 6 7 $g 
[ 0 0 0 5 ] 

[ * 93 tf s #P ife L «fc 9 itSRi] 

L a» L * a* , ± IB * & W I- fc o T . « l- u - y £ ® ft 13 - 4*1 * Sr f* ffi "T 5 fc » . 
Hi 8^J: iCiftlill^tfufiiif B i:^gi^g;5^-y > * tt H l 9 <£> J: 9 

j|[ii^T*t>fflh*A^ifi< ^t^Slt5i/->?C)PfJET^4^c 
[ 0 0 0 6 ] 

0 * , « tc u - y i m - <o m » & m ft -e m ts -r s *J tm* , -«»i:^^7j;na» 

ftOil/^-y^ff jtfA ( gj iS S » td , f ihf A) h LTiil^B^t^ 

If ^l^t^i3?BC§3^x.5 0 r (D t # , ffJh*A^«jffua^5tta 

I^ICJ: 9 1? lb m A £ ® ii * B o ^ T ii jft * fr X. ME PpI H (2 ft , H. fiE *3 J: T>* 

fi^f J(:io(t5C P U fig * "C fi , © ft 5a S ft 4fe f# ft 1 * (c K ix T L S 2 0 
[ 0 0 0 7 ] 

# 9B 9! . ± IS PS £§ Id * S L T ft * *x Ac r* . t(OI«i:t5ir5ll, H ft <£> f$ ^ 

# . i^Ml^Sf AiS^gigt'f 5$Sffl^#f agi5:git6 r irCfe^c 

[ 0 0 0 8 ] 

»*fti45prttt*Si*®«t tt)ftilt5*iIlfia»ffl?Si, ii fi* * <D 4£i f$ tf> 

SixfcftftiaSf©***^ - TMi ft £: ¥U » £ *x i: # * g liflfi S 2 «f|g(: 

r i: 2r «r» tt5 0 
[0 0 0 9 ] 

a m & « > aKS*tfc«**si»**i:ftsprffitti:. ii»*^ft** s i»**iftapr« 

[0010] 

. ift*&Iltttl?ai 0 1 ItS >9 iA^^g 1 0 2 aiftftlft^g 1 0 3 

miMi&mvdfc&m^&i o 4 t . ^i«feft«*ai#©i 0 5 ^ , ^ 2 stftasai^s 1 0 

6b, 0 7 ^ £««#lR¥ftl08H^fAitie, 

[0011] 

ftBftftfilftffi^t 1 0 1 ii, <&&4&#i^tB^ffie£rtti;ft-r5o (Sft^^^^^JSl 

1 C0tti^licS<5# £ J|l {d £ oTft^a@ lfcV^($^ 1 Ofcitl^t 6 0 IS « & 3 4* # il 

0 4lt 0 3T*IRLfctt(*:*lO»IWl:#SL, If {ft % 9 a 
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[0012] 

mmm 1 nt ft s » ai ^ a 1 o 5 hl , tti«i*is{fsi 0 3t'i«Lt»#^s*i:i:o 

t»S»i45^Iitti Ltl l*ft« Sr*fflt5o *2»ffl«J|Hi#ai 0 6 11, Si ft 
&31^f*ii^^J£l 0 4"eil#t©ft*^e*i:i:oTI»t«i:i5?riEtti: IT ffi 2 56 
ft « Sr * til 1" -5 o P — ^ f# *J ifr 3^ IS: 1 0 7 f4 , SlftfflR^Si 0 3 ti/cftft 

[0013] 

mjteii^^fr^i^^si 0 8(4, i i iff g^i 2i(tg^-i(*«i^^ 1 o 7 <om 

[0014] 

»: tc , 31 tt o m m * m % i- £ * * w * 01 sr k m -r z> . 

[0015] 

(IB 1 X tt 0>J ) 

si 1 11 m it . m * m 1 . 4 , 5 , 6*3<tt;7aicjtjet5fc«)-es>9, s « *a a pi «e * 

^^tffl5ftx.5:H:J:9, ^ W ft 7 * - 3 >- > 

[0016] 

4 -f , « fig Sr K i" 5 o 20 

mm mm 2 a* » » s n * r©i/-^ftisi2-eii-o4fci4«ft 

[0017] 

iA^-^S) 3 ^ « « $ . (Bft^a^ffcigiW^iS:) 4tc^ 

m £ ti z> o i^iiMigf4 TMii^-^^iii 2 tats L/:is«ftii(oii#is^ 

(c, HftfeS{cJ:0*#*<*»t"*iaa^llJ6*ixa o 

[0018] 

^4:^ffii-5^*t^^tii^g7^S^^tb5o :o±5iA-KtS^b, ^mmcDM 1 

» « « Htm ^ a , jB2*««jnai*a, ra — *«e««*a«J:tfiisiFW*»R*ik^»s 

[0019] 

fiiffc^u — *»JW§g«8lcSE«ESix.S. * L T , iu « *ft (4 ft Sc ft *J ft ti % m f& ir 5 A 
ffi^u-^y^-^^ 9 — *»J«I8 0> WJ » * « ❖ « EE # 

A EE ^ u — ^-^ — ^^ 9^yuy-r k ^ ^ *n $ tt 5 ^(-4 9 tT & 0 ~ ti ^ <d 

l/-^feIii2 J ?gS/l/- faJ i^P l£ fi 8 {4 , ^ft^;h,^>f*P = V^^ — *£-€r<E>J3 
i22^D n p^#@r^^^^-^^iEtt)[H]Sgft^^fi^. 51 iMc ii ft In] £: ^ L T tf $g 3£ ^ 

»t5. 
[ 0 0 2 0 ] 

ft ic , f|s /H Sr K W "T 5 o 
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X. Ji > 10 0 [ms] SlCifi^tL^ 
[ 0 0 2 1 ] 

* 7- y 2 0 1 -C tt , ^*t = ^^ai^-f ^-^^*»Lfc#ft*^ffiiS:R ( P x _ 
z 0 [i] , Py_z 0 C i ] ) ^L-XStiAtPo - - -C , SSxL*=©xttSt*l^l ( * *M * 
ifij ) (OftftfiltfcoT, y li tte ft co ji g ( * m S§ PSS ) tfcSo 4 , i £ tt # 1$ £a 
OID##T*0«±(OS»S>9, z 0 ili^EOltS:, z^il^V^llV^ClOOm 
s) 5fe fit £ , z n ttn-y->^y^^iiB*(0«Sr, -tft-ejxjftBfet-So 

[ 0 0 2 2 ] 

^r^ 2 0 2 fit ccd*> 7 3^b^lil<Dty^y y^ictsit 5»»8* ( W ft ) 
Sr Si «9 iA tr. 
[ 0 0 2 3 ] 

* v- y "7' 2 0 3 V I* > ^7^2 0 1 tt»Lf:#«($ ( # I D # ) <D tf> b . ft t & 
I t^)fe*^ 1 «)f*lRt5 0 * W * gfc tt £ . H6tf)7u— ^^-Mc^-To 

[ 0 0 2 4 ] 

^77^ 2 0 3 -lT'li, ^BOfy^y ^i/lCfcltSKB^tlV s p tKft S t r 
<t 3 — U — h d </> / d t 2r trc <^ i£ 0 
[ 0 0 2 5 ] 

^ 7 y y° 2 0 3 - 2 T* fi , X t y 7 2 O 3 - 1 f * ft * I t (Sft i: 3 — U — hSrffll^T 

, Tte^^: (i) xvsiiL(Dm&(D&mm.m*. smnmrn^m t i,x =?m-r z> 0 

R = Vsp/(d</>/dt) (in case of Vsp>30km/h) ••• ( 1 
) 

R=(lf+lr)/Str(in case of Vsp^30km/h) 

* L T ^ 5 c 
[ 0 0 2 6 ] 

* ^ ;y 2 0 3 - 3 T*li, ^ r y / 2 0 1 ^K*iiA/«»***^ffi:«^fee*i»jtt-r 

5^^tt^St^Sv^fflx^ig^-<^^/^<7)^^#^Tfec7)^: (2) ^ e> . g*B^y^y t* 

direction C[i]=atan(Px z 0 [ i ] / P y z 0 [i]) 

( 2 ) 

di rect ion__L [i] = a tan ( (Px_z 0 [i] + W_ z 0 [i] / 2 + 

w/2)/(Py_z 0 [ i ] ) ) - ( 3 ) 

[ 0 0 2 7 ] 

S^dJt-rsHESftftW^ffiSftiSft^^ hyK^lPl^SrTISoa; (4) ~C % ffi L . C 
ix (- J: 9 , tt&»*3i5gti:i:ot**»i:4 9»6WilttS:TE©* (5) l^i 

direct ion[i]=atan(rVx_zo[i]/rVy_zo[i]) '"(4) 
Recog.rVxy[i] = H.2/fabs(direction.L[i]-directioii.C[i])) 

*fabs(direction.C[i]-direction[i])+LO -(5) 

r r. T*. Re c o g_r VxyttSStS^lEtt^ibiitl-flO. 8?)^l4TOKl 
£ & 9 . ^ b£ t£ {£ v MS <fc^ £ VMS £ ft £ . 
[ 0 0 2 8 ] 

* 7* y -f 2 0 3 - 4 "C tt , A (1) t'lffi It l«LWR/5)^, Tf^S: ( 

Recog_Dist [ i ] = ( - 0 . 2 / w / 2 ) * a b s (hypot (Py_z 0 
[i], (Px_z 0 [i]-R))-R)+1.0 - ( 6 ) 

r r T* , hypot (pi, P 2)f^(pl*pl + p2*p2)° - 5 S: il i" §| ®C & 
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9 , Recog_Di st [i] 6^Jitt^fc§ ^ 0 . 8 h 1 * T* <D «5 

ffl £ Si 9 . "5T h6 ffi {£ ^ f5 if /Jn $ u> fg i: £ 5 „ 
[0 0 2 9 ] 

^f^ 2 0 3 - 5 Tlt * (5) , (6) -Cj|fflLfc2o©g!«iPlj6ttS: lo<^gS«!pf 
R p r o b [ i ] = 

func (Th_rVy_L, Th_rVy_H, r V y _ z 0 [i] , Recog_r 
Vxy [i] , Recog_Di st [ i ] ) (7) 

r r -C , Th_r Vy t T h _ r Vy_Httl»***JWf*ffi^S**»*5iBS*iatt-t? 
£ 0 func ( a 1 , a 2 , a 3 , a 4 , a 5 ) tt H 7 i: * S ft 5 i 5 4 Wtt S: fto IB 

^-efc9, «*rfijoti*tjia[*s/h $ t * tcttS: (6) ©gs^lli, *B it ii If a* # 
^ir^tcttsK ( 5 )• co £ 5 o 

[0 0 3 0] 

#^($Co^Tg$^g)iHlttR P r o b [i] & % ffl L fc « , "f^TtORprob 
[i] <7)^^j^^W±iS^^|*<D^a>b:S:t>^ -t CO 4fe {$ I D # 

s 1 c titio -T^TORprob [i] a* IS ^ W ± i: ft £> ft ^ (BSift^SSL 

4tO 4§ ^ (- (i s 1 c t = - 1 t "T £ o 
[ 0 0 3 1 ] 

2 0 4 tlj:, ^xy^203-es 1 c t < 0 CO ±# ^ (i . ^x^^2 2 0^. 
5 "0 * ^ j§ ^ \C it * =r y -7 2 0 5 — it tf o 
[ 0 0 3 2 ] 

Xf?/7 ? 2 0 5 t'lt, lt^ll:J:5tl*ii»^tTori^^S^^7 7^ : IP_Tr 
a c k i n g J;^l^^ 0 :(D77^li, if felia^ h 7 7 ^ > ^ ^ff o t i 
^ \Z I P _ T r a ck i n g = 1 t ft 9 , * li I P_Tr a ck i ng 

= 0 i: ft 5 0 r C X* . I P_Tr a ck i n g = OOi^Cll^f y ^ 2 0 6 ^ „ t 5 t 
^t^I^C (i^r 7^2 0 8 — iS ir 0 
[ 0 0 3 3 ] 

^ry7 p 2 0 6 TMi, ^77/2 0 3 T*IR L f:t)*(7)|ii : R (Px_z 0 [ s 1 c t 
] , Py__z 0 [s 1 c t] ) tcSo < iSggCS L T , 4^*<ottaj^tT9 ( #] [U tt 

urns £ np-s) o 

[0 0 3 4 ] 

^ X 5" -? 2 0 7 \X , ^77^ 2 0 6 T^0ttai^l^*aLf:i^(:ii, 

(Px_z 0 [slct], Py_z 0 [slct]) iIftOxy^fittOBI«#tt 

ydfc&m? 7 J? £ I P_Tr a c k i n g = 1 i Lt^JlT, * *r y 7 2 1 0 

— it if o Wln]ttm^3g^^^Lfc®^{C(i%tfiill*77^SrI P_T r a c k i n g =. 0 

© ^ I C I T 7 7 7 7' 2 2 0 — it tf o 
[ 0 0 3 5 ] 

[ 0 0 3 6 ] 

^77^ 2 0 9 «, ^7 7 7^ 2 0 8(Oiftfelt»tt^|»t^f:§^l:(t Ifei^I 
^5>*ait5*#^fii : I (Px_z 0 , Py_z 0 ) £ H ft t" S 0 IfttMilftftL 
A* t& m L ft ^ fc tf> , I (Px_z 0 , Py_z 0 ) tt * # 5 — £ ft £ 0 
7 7^li I P_Tr a c k i n g = \ (D % % ~Q 7^ "r y ~f 1 1 0 ^ it tr 0 Itt-i 

mfc&f&Ltzm&iztemt£&m77iy$: i p„t r a c k i n g = ooi:s^Lt^f^ 

[ 0 0 3 7 ] 

X777 a 2 1 0 -CK* , Mlft^*»Ufc*#^e*J-fcoTl»*4fttftS"BTffitt : I p r o 

b ^» Uit^o AffcWft;£i££LTte, y^2 0 3 ira«"Cfc5, r. r -£\ ipro 
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ilKCS^t (o*9Recog_rVxy-Ctt*<Recog_Dista»e>) I p r 

0 b ^ittlt6 0 ft if ft <b tf , It&ltltBl/ift^^SKi^igT^a^, Ifii 
c7) fit S 14 S ^ fc » tK # J* * * & B t i" -5 tB 2* iS * ^ * ^ >f K: # ft ft ^ rt» T* *> S 0 

[ 0 0 3 8 ] 

1 1 (4 > I«"e»tPlfc«*t^7yy 2 0 3 tlRLfcl/-^«S*^ia 
— ttftc-C&S^S^^tiJWrSrfifPo A ft (4 m x. tf T IE (O s£ ( 8 ) , ( 9 ) <£> ^ ^ Sr tt 
filtfeia-ttfrilJWti. r r. -C , - y fc H ^ IH ^ * * M tE * i- fi * ^ * ^ 2 
2 0—, * 5 t? * <^ » kZ (4 X 7- y -f 2 1 2 — it tP o 

abs{ R(Px_z 0 [slct] ) - I ( P x z 0 ) } < Th_ 

P x 1 ••• ( 8 ) 

abs{ R(Py_z 0 [slct] ) I ( P Y _ z 0 ) } < Th_ 

P y 1 ••• ( 9 ) 

r r -C , abs (A) t (4 , A ( 31 » a r g u m e n t <om?C^) (D M OS. % & 7) ~t Z> M 

ftt-feS, * *: , Th.Px l ili**ffii©ftjaiffit©*fti:»t5(HI-cj)-ot, Th 
_Py l ili»*fii©tt&ttii:Ht5l!lfi-CfcSo o £ 9 , u — ^ «'*q fit 11 £ IB flfc <*> «fc 
*n fit S ^ 0f ^ J: 9 t Ml ft fc » ^ ic (4 , 5**t*jai *t^ 0 

[ 0 0 3 9 ] 

::tMi, ^ <o fit s <o ^ a> e> *PJ Wf l a* , u--tf^fifi«cAft#^>f9^^i:^»-& 

IU « l- > u - ^ i B ffe TM* gij <D m * S: *0 L T ^ £ r t ft £ c C ft Sr *J »t 1" 5 011 i: L . 

X , T IS <D it (l 0) , (l l) OS*t«St5 i: i/-^ft»«lc:Aftf to 9 ^4 

£ ¥U »r L . ^ ^ ;y :7 s 2 l 2 — ii tp <t Ltt)f^4i/\ 

abs{ R(Px_z 0 [slct] ) - R(Px__z 1 [slct] ) } 

> T h _ P x 2 —(10) 

abs{ R(Py_z 0 [slct] ) - R(Py_z,[slct] ) } 

> T h _ P y 2 —(11) 

r C -C N T h _ P x 2 , Th_Py 2 MiKf[H]K(Hl^t>^!i>^Si«7)0l:ft*©l 

^(-H-r^>rF^fii:^*LTv>^-r 0 0^9. ^ m t mm <d ^ *s y ^ y \z & v %> u — x 
*t>aa-rs*ff3ftsaEto&**tftfi ( a ft # to 9 a* ^ ^ # ^ ^ « ) . *t (10) , ( 

1 1 ) 2fc i2 14 Jt « W /h S ^ «S ft 9. IjiCiDWHrtf 5o 
[ 0 0 4 0 ] 

^7 5/^2 1 2 "Cli, I probirRprob [s 1 c t] h \ T f £ <£> 5£ (12) , ( 

i 3) <DMjj%ffiti-rm&iztex<ry72 i 3 — m & , ^ 5 t* ft ^ ^ ic *4 * ^ ^ :r 2 1 

4 — it tr e 

Rprob[slct] < Th_Probl — (12) 

Iprob < Th_Probl "(13) 

r ^ -e . t h _ p r o b i 1 14 me m m x a ft ^ t n m x # 5 s s o /j^ s ^ it * * * l x ^ 

[ 0 0 4 1 ] 

^^3/^2 1 3 "C (4 . fel fci&Wl 7 =7 ? & I P__Tr a c k i n g = 0i: L T !) t y ht5 

0 ^ft(Cj:»9. *0Oli^lt(j:^f 2 0 6iC^^tl/-^^a«)*^fii : R ( 
Px_z 0 [s 1 c t] , Py_„z 0 [s 1 c t] ) fc»^#ffl@fflm««asiTtoft5fc 

«> , »*«6iE«^3ai**#e>ftSo * u t , 2 2 o^it? 0 

[ 0 0 4 2 ] 

^7^/2 1 4 t'fi, I probi:Rprob [s 1 c t] h . TfBCO^ (14) , ( 

1 5) (DMJj^ffiti-tm^^te*?- y 2 1 5 — m & , ^ 9 ft I ^Jr ^ (4 ^ ^ y 7* 2 1 
6 — it tP 0 

Rprob[slct] > Th_Prob2 —(14) 
Iprob > Th_Prob2 —(15) 

r r X % Th_P r o b 2 ttt»»»-C*5ilt<|-(?t58S©*t^ilS:S!*UtV^ 
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[ 0 0 4 3 ] 

X y- y 7* 2 1 5 "C 13: . #H$iIGff:77^£l P _ T r a c k i ng = lCO^^(:ir>yhf^> 
0 : ti i: J: S0o®f ^l^tt^ r ^ 7° 2 o 8 (:^^ TMiil»i($(7)fiI : I ( P 
x _ z o , P y _ z 0 ) I:ldti6»ftl^«ff$n5t», lt**7|B«©J»*^» 
bix5 0 ^ It, y 7°2 2 0 -Itf o 

[ 0 0 4 4] 

^7 2/7^2 1 6T*lis I prob^Rprob [s 1 c t] h , Tte^^ (16) 3: jg 
tti^C (i7f ^7^2 1 7 — if & . 3 "C^C^il^lC (±^r y 2 1 8 — it tr 0 
Rprob[slct] < Iprob •■■(16) 
[ 0 0 4 5 ] 

7, y- y •? 2 1 7 tt , % & ®l 7 7 ? & 1 P_Tr a c k i n g = ltf>££lC-ir;y Ft5 

o : tt I: J; ^ ft0oi«»l-eii^f ?/ ^ 2 o 8 i:*5^Tl*i6«;*«:«)ffil : i (p 

x _ z o , p y z o ) * # ii » & m asm ft s n 5 fc #> . «*a4Et©ai*#»6 

ft. 5 o f Lt,.^f^/2 2 O^ICfo 
[ 0 0 4 6 ] 

^77^2 1 8 tit IprobirRprob [s 1 ct] h > T f £ 5£ (17) £: ffi 
fc -T 4ft ^ i- tt * 7- y 7 2 1 9 — it H , * 9 -e ft *§ ^ fi ^ =r y ~f 2 2 0 — ii tf 0 
Rprob [s let] > Iprob -(17) 
[ 0 0 4 7 ] 

^7^2 1 9 tit »*i6»77^^ I P_T r a c k i n g = 0 L t y t j/ F t 5 
o r *l (C £ 9 . ft@(Olt^ITMj:^r ^7 P 2 0 6 (Cfe^T : R ( 

Px_z 0 [s 1 c t] , Py_z 0 [s 1 c t] ) l:S^5t«]l5]»ffl*!Li^ftbh5fc" 

[ 0 0 4 8 ] 

^77^2 2 0 T- Ii ; x -r ^ 2 0 3 ft }£ <D m ft S SI W iz. ffl ^ £ j« 3& (d o ^ T ig * fit £r IE 
[ 0 0 4 9 ] 

2 l 9^)*#ia!Jlttf ©ISaiJr^y hD-;i,tSo - til- <t 9 , K ffe #L m pI b£ ft 

l§]^tifti:iLTltMI^ff 9 r t ^ pj fg t ft <9 . 7 ^ - 3 v J; £ m ffi <z> S5 ^ 
^#B«*SrSHMft^o-fe 3/ * - m J* X*M S 1" 5 - a s pT m t ft 5c 
[ 0 0 5 0 ] 

[ 0 0 5 1 ] 

■c tt ft t *J »f * ix fc » -fr ^ , u-f u-y 1 -ettJpLfcftflcs^f-ettM^ftttpr 

fg R p r o b [s 1 c t] t , IftftlSl4t*&Lfcft##6*l:io"Cl»*ftt 
ft^^I^ttl p r o b £ (7) H K JCS C X . ifi*t5»*tfl!»it5t», t S $ 
ot*t8ltt5«5©fc5»**I«t5^i^'Cf 5 0 J; o T . M^^^^i^^l^ 
fle I- PS ft T* * , WfcttS^WHAWSrT if ( » * 51 l I- » ft? ) » 

[ 0 0 5 2 ] 

Rprob [s 1 c t] tfi p r ob i9 t*SV^i^l:tt, Wlfc^iiSSSritttfi-Sfc* 
[ 0 0 5 3 ] 

Rprob [s 1 c t] 1 pr obin^J^I^Clt W«^iii*Sr34l»JJ»TL, 
u-yj&&%t^lElttffl*Gj«f£«k 9 *P L B: i~ fc & . ig ^ ft ^ ^ y^ti/-^i:0-^ 
*«r5C*^tftftiLTfll*tt«ri«ft*ii:*"C#a ( IB # « 5 K *t JS ) . 
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[ 0 0 5 4 ] 

Rprob [ s 1 c t] t 1 pr ob^*l:Th_Pr oban^J^i^l^t ® 

*Sru-^tfc*i»lci9J0|ftjtac4:-C, W « #3 t ft 5 a> t> L ft * ^ 4*) » tz , ip- M {z 

ix5:H5t^5 ( ffi * « 6 ic *t JCS ) o - » lz , i/-^J;9 t*^ ?0**J£a»f!T 
fc 5 ft , c^«t 9 4Sffili, i/-/tt*B6S*lRli:a^»*S:ftaLT^5#, I* 

-tM* «t * irj ( * s * f^i ) i-itv^&T-fcoTg:*:co^^iHj^ 

5 o 

[ 0 0 5 5 ] 

Rprob [slct] il p r ob**l:Th_P r o b 1 ±H*S^i^l:tt, I 

6 <D & m & Wtft 1~ & tz , W-yHift^T'tSiT^ftt^ft:^ l/ — yt-KS^Oftft:^ 
S*i:o^ttttta:b4v^>^r A«fiSdSpfSli45 ( ft * * 7 tc » j£ ) 0 

[ 0 0 5 6 ] 

@ 8 \z , u-^ttto*4:Bii«1**P*^a*5»'&(-*3*t5, H ft £L a o T * > a > <h * (D 

9J) ^ & ~t o 

[ 0 0 5 7 ] 

» 2 H Jg 0iJ tt . » * « 1 . 2 , 4 . 5 - 9 II IC *t -r £ <£> -e fc 9 . ^lHJS^JfiU' — ¥ 

^ jo rt 5 . IftJftl^^ilBjftlS:^^ bo-^t?>:it, H ft' & S <7> it ft * ^ {g; 
^S^cW.iStSt^f fc5o ft *5 , *2Hififi»J<z>fll*fiBI2{c*bfclSi^l6 0iJ^»« 
k 1*1 - $> £ tz ft , KSS:«l5t5. 
[ 0 0 5 8 ] 
ft ic , ffl «r » * . 

0 9, l 0 f* , iiW*(*:»«WJ»»a©j«^S:*i-7o— ^--ir — h-C*>a 0 ft . ^ l * 
it « £ 13 — «R # I* . H-©^ry^#fSrWLttt«t«et4o 
[ 0 0 5 9 ] 

^fy^ 3 0 7 "Cfi, ^l(O^S£0iJcO^^^^ P 2O7i:f^1t-efe5^^ :tLf:*Xt, ® 
ft&StfSJltftJl^^iS^ftS::^*^*-^^:?^^ : I P_S t a t e = 1 £ ± y h ~f Z> 
o Z. <F> ~7 7 ¥ 1fi I P_S t a t e = ooi^i: (i, Italia V & WF & ff o z. k(i 
-eitv^*, *ft»ffi«««tti«<ftv^4i-&SrSc!*LTV^S 0 
[ 0 0 6 0 ] 

^7 7^ 3 0 9{j:, Il*fiW©^fy^ 2 0 7 ^{Jffl^lf T*foS/5^ ^ ft AD x. T , K 
ft: it ^ 7 5 ^ (2 I P_T r a c k i n g = 1 t Itt 5/ b ^ fC > pj ft *>L J; 

6ii^T*<^fi:«*t^SrlB-<. »S S < Hlfi $ ^tilf I P_S t a t e = 1 *t y ht 

5 o ii ^ T? # fc * 5 fit a ft S ^ M ^ ^ ffi fo 6 it IC I P S t a t e = 0 iz ± y V 

t5o MfcfoteJj&tLXtZ, 31 2/ *J # Iti IZ ± 0 « * «T a L fc » IZ tt I P_S t a t 
e = 1 i:ir>y h L , - y v ?/ f > ^ C J: «9 « tti L f ^ (C (i I P _ S t a t e = 0£r 

[ 0 0 6 1 ] 

y 3 1 1 tt , ^i^js^j(7)^x>y^ p 2 1 1 tmmx'fo z& * m 1 MMmx & u - y 

ilt^^-feft^tt^ tt^^I^CIi^f 7^ 2 2 0 — m A;X*^W$l : fc%k~r L,tz<D \Z 
[ 0 0 6 2 ] 

^7^321tft TIB COS: (18) S:«J£t5»^fctt^7 1 S'^ 3 2 2 ^1*, ^ 0 
X ft ^ * ^ tC (3 * x * ^ 3 2 3 — ift tP o 

IP_State = 1 —(18) 

[ 0 0 6 3 ] 
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^7^ 3 2 2 TMi, f* 7 5 ^ Sr I P_T r a c k i n g = 1 (Oii Cir 7 h £ 

x_z 0 , py_z 0 ) izm^$&m>&±m&m?r£tiz> 0 ^lt, ^3 2 o-.ff< 

o 

[0 0 6 4] 

^7 L S /^3 2 3-Ctt, S: (17) ^iJ£t5i^C(i^f ^7'3 2 4 ^i|^, 5 ~C & ^ 
I^CIi^f 3 2 5 ^ it if 0 

Srfflv^fc^Hfift^WW* : I P r o b 
[0 0 6 5 ] 

7 7 7^ 3 2 4 TMi, ^ffci6J*:77^ r £:IP_Track i n g = l^)J4l:t^ Ft5 

0 ~tllZ £ <Q ^ ?j:[El©Ii^lT(iXf '7 7° 2 0 8 iCio^TIIIiiiift^fii : I (P 

x_z 0> P y _ z o ) J-*<5#i6t»*Qf3a*s «E It $ *t 3 . rn*cJ:5«*qi8IB«^«i* 
^Ilbtl5 0 -^r L T , ^7^ 2 2 0 ^ff<o 
[ 0 0 6 6 ] 

^777° 3 2 5 t(t »*il*7 7^«: I P_Tr a c k i n g = 0l:ytjy ht5, ^ 
fri iz X <9 , ftB^SftiB-I-eii^r 2 0 6 lc*iV^t : R ( P x 

__z 0 [s 1 c t] , Py__z 0 [s 1 c t] ) lcX<5#4WEttmteS#fTfoft*fc»s 
r *i ± 5 f« * q[ 9 E 4K <£> 3sb * # #■ & *l * o tit, ^7^ 2 2 0 ^ff<o 

[ 0 0 6 7 ] 

: © J; 3 I: L t , \s — y fetoto ft k m & fcffi m t m & X* l* . l**n»tfS|***fc*S 

5 . {zMJ£-tz>z-ttf-*imt%:<9, 7 ~ — is a > x z mmv}i<o\Z}± t GLwm&<D\*)±& 

[ 0 0 6 8 ] 

ft d , Sfc * «r » W S . 

[ 0 0 6 9 ] 

U-f l/-^lt^^L/:ftftS©^t|{)g^««^SttRp r o b [slct] 
<t . IftteI8t4-CSSilfc«)#^S*i:totl»SfttiS^figttI p r o b i: <£> Bl 

^Sv^tftKiSEi-eo^ ht5RTIItt©*5 i/-^©/<y ^7y^is^ti:4 5 (ft * 
2 (C » ) o 
[ 0 0 7 0 ] 

mi&i&m<o{iL&tt&&i&^ ± wwi z tittm&^ b . ^-y^*figR p r ob c s 1 c t 

1 ^ ffi t tt T h _ P r o b 2 £9 b*#V^#^JCttBfft^iiB|:SrittfTi-5fc» % S h 

5 u-^0/^ix^7y^*prii:4 5 ( ft * m 8 tc M ) a 
[ 0 0 7 1 ] 

WfcifiWOtir«*»«asffi^fc*J»$;h,. rt> o N ^Oilf g R p r ob [ s 1 c t] 

BrSttTh^P r o b 2KT"C*5i^i:tt, It OilW^-gS^SJU-T t N K ffi ^ iff 
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ft o 4ft ^ , Mftiai«:*II]^b«!)St:itSftS:BSI»ST'S5o -ft i- J: 5 . # 

* W (c K * m t ft 3 » ^ ic: AS » ft ft ffi ffi ffl a* B « ^ b H M -c * 5 ± 5i:li5:i#-e 
#5 ( « * il 9 «■ rt; ) 0 

[ 0 0 7 2 ] 
[ 0 0 7 3 ] 

(S3HSW) 10 

s 3 m m m « * » * « 1 — 1 2 11 k at -r 5 t © -e 9 , n 1 , » 2 n it « « , h ft *a a 

r ft (C JbO x. , «a^ffl*i-S**ffl:«Sr. ^yy/uc^Sgftt^, ^ o , 9 ft] ft ft * Sr 

iRitiBAt5t©tfc5, ft *j , si 3 m m m <o m /* « m 2 id ^ l si 1 % t& m <r> m 

t m - t? fc 6 > KWSrf »t5 8 
[ 0 0 7 4 ] 

11 2-1 6ii, a»**i«i»*ioithS:/Tt7D-f ht-fcs, ft *s , mi 
& £x$m 2 mmm tm — *b # 12 , ^-©^ryytttwitRwsrt nt5 0 20 

[ 0 0 7 5 ] 

^ 7 1 y ^ 4 1 3 , 419, 4 2 5 tli^ #*ilB7 7^S: I P_T r a c k i n g = 0 i 
LTD f I, ^7-7/4 2 6^Itf e 

[ 0 0 7 6 ] 

^ ^ 3, -f 4 1 5 , 417, 422, 4 2 4"Cli, »*ii*7 7^S: I P_T r a c k i n 
g = ICiilCty s/7'4 2 6 ^Itfo 

[ 0 0 7 7 ] 

^ ^ y ^ 4 2 6 "C fi , S: (1 2) , (1 3) S: *SS fc; 1" 4ft ^ (CI tft * *r y 7 4 2 7 — if 

^ . ^K*i^i^CI^7^/ 4 2 8 — it ^ o 
[ 0 0 7 8 ] 30 

fo5R(Px„z 0 [slct], Py_z 0 [s 1 c t] ) 4:«ft^ai*l, 
^ 2 2 0 — if tr 0 
[ 0 0 7 9 ] 

* X y ^ 4 2 8 -C . S: (1 4) , (1 5) ©iJ^lttl^C (i^T y7 P 4 2 9— it 
^ % ^ 5 x ft v> 4§ 12 * T y -7 4 3 0 ^ m tf o 

[ 0 0 8 0 ] 

^7^ 4 2 9 tli, S^i8«ffi«<Dfc»©B««»«SrTSE05t (19) * * L . 

:^)i J^^i/-^ h;v^, ^i/-^JE^Tf^S (2 0) ^b*^5 0 r. ft 3: u — ^ 4ft 

?s"T y ~? 1 2 O^iitfo 

a CA = (Vp 2 - Vc 2 ) / { 2 (L - Lt) } - ( 1 9 ) 
where, Vp = Vc + Vr 

Tbrk = Tw - Rt Rat Rdef ( Te-Je dNe ) — ( 
2 0 ) 

where, Tw — Mv a c A Rw 

r r t* , S: (19) coa CA (^@H*Piaft, vcf^g^:^^, v r liftftt 

Lli«**-e©E«S:, L t"tt l**WSllSr*LT^S. * , * (2 0) OTbrk 

l£ Z> h ? * Ra tfiAT^^il^TJtSr. Rde f fir 7 ¥ 7 Jt S: , N e (iltijf 50 
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5 =■ > is is m fc.ft S: , d N tt -t 60 B# flQ » # « £ . T e 14 N e X * * 5 ^ > V rf \y - * 
V )V ? & , J e (4 aiv^ - V^Sr. Mvli@*fi0l^, R wliSi^SSr, * 

[ 0 0 8 1] 

^7 7^4 3 Otli, ^ (16) £ ffi fc -T » & \Z (4 * 7=- y 7 4 3 1 - m * , ■* 5 ft V* « 
§l:ii^fy^ 4 3 2 ^ it tf 0 
[ 0 0 8 2 ] 

* y :/ 4 3 1 T* (4 . l*^^Si^i*f^©fil^^\ ift)6t)l«*a«lOffil-?fc 
SI (Px_z 0 , Py_z 0 ) ^mm-tU^jL. ^fy^2 2 O^ltf. 
[ 0 0 8 3 ] 

^7 7^ 4 3 2 f li, 5t (17) ^if:ti^C(i^r y7'4 3 3 ^1^, tp^ft^i 
^ {z f4 x t- y ~7 2 2 0 — it if o 
[ 0 0 8 4] 

x T y -7 4 3 3 "C tt , »^ffii(Offittt**^<^ffi«i:S:, J? *, 6 fc u-^M*i4£><£>feB 
"C fc 5 R (Px_z 0 [slct], Py_z 0 [ s 1 c t ] ) ^tt-ffl^ Lt, * 
T" y •? 2 2 0 ^ it if o 
[ 0 0 8 5 ] 

^ 7 y / 4 3 4 t' 1^ S (18) ^l^t5i^CI^777 s 4 3 5 -, ^5^4^*^ 
{4 * x ^ ^ 4 3 6 ^ it if « 
[ 0 0 8 6 ] 

X 7^ y 4 3 5 X\± , SJfiOfifliU-yftjSllftOlfiitfcSR (Py_z 0 [s 1 

c t] ) Sr , ^*r^^fiS(4iiJ^^*a^»^«{iMT-fc5i ( p x ___ z 0 ) 1£ i£ — 

Lt, ^75/^2 2 O^Itfc 
[ 0 0 8 7 ] 

£ R (Px_z 0 [s 1 ct] , Py_z 0 [s 1 c t] ) £ ^ g ~- aB^LT, ^ y 
^ 2 2 0 if e 

[ 0 0 8 8 ] 

:oj;3{iLT, ^*&ttf*:£H4feifi«ttfM s H£a*5a^ *3 J; T>\ Pt^ 4^ ft ^ > 

it ^5 0 
[ 0 0 8 9 ] 

[ 0 0 9 0 ] 

Rprob [s 1 c t] t . B»ifei«i4*e«j3iLtft##gti:t ot»f »ift5 
tt I p r o b M S -3 # > Sg^fflAt5ft*ffit«raRWI^^t5fci(), ffl^^i 
g^^tli*tSfl:tfeil»Sftt5:Hst#5 ( §* # * 3 «c at jfc ) 0 

[ 0 0 9 1 ] 

«E*lpj'(*IHffi|(i) & is — yomtl . m.J5fa ( * *S * Ir) ) asH«tfe»W<0fcb*i:*5J:5 
( 19 * Jg l 0 (c *f j£ ) 0 

[ 0 0 9 2 ] 

l/-^tMi^l^-t{$^iil»ttV^n^«iL/:l'&, Rprob [s 1 c t] # I 
p r o bi:«9 fc /h $ V* » ^ ML . «*^t>**r^fc*(C®«tft»»Offia*«ajcm^L 
x Rprob [s 1 c t] *S I p r o b i!) t**^i^|:ii, ffl£ 3j fa h ffi fa h & \s 
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— ^tft*P*<Offi«Sr«a^ai*L, Rp r ob [s 1 c t] t I p r o b ^»C3f^lT 

h_P r o b l J: 5 t)^S^i^i:ii, Si^t)«*fi^l:i/-^tft*ojiS^|g 

— ffl i~ Z> tz af> . Sg^^ffl*t5ffilittSl:i£i:ta«Ilca*t5w i^t#5 (fit 
* il l 1 M it ) o 

[ 0 0 9 3 ] 

U-^t ffli^^-ft^^illW tllli Lti^, R p r o b [ s 1 c t ] t I 

p r o b # * CI 0f ^ ffi T h _ P r o b 1 «fc 9 (J, «r ^ i£ it {& i$ <D § 

^ $ (o m & ic , S*lciotJ:!)ia4«*ffil«:»S^ttlAt5: t*T#5 (IS * 
« l 2 iz M It ) o 

[ 0 0 9 4 ] 

[13 1 7 (c, tS^©ftttftfifi^ffi^t5K^*ttt^oaiS:^to 
El b o ffi ip. # tft 0J ] 

i i ] m pi ffl ^ r m m m s <o « * * * -t- ^ * * * is -c *> s „ 

HI 3 ] |g 1 H£S 0"iJ(OiB^^f*il^ffl^MS^i1ttL^^"r^ n — ^ * — h T* fc 5 „ 
14] « l ««M^il»«*SRM»»i©«iiS:/Tt7D-f ht-*Sa 

15] ^\%mm<D^m^wm^u^^M(D^^i^:f^-tyxn-- ^ — h -c *> 3 0 20 

16] itl t5ft*SrlRt5i8!i©ahSr*t7 p-f + - 
17] llf un cO»tti:«t^y^"Cfc5. 

^^^r^-ri-efe^o 

I 9 j ^ 2 mifo&i&mmfafcMfcfflfflf&s&ffiti&^'i'y * — =?- ^ — y x & z> 0 
110] m2mmm(o^m^i^m^mmmm(Dm t ti^^^yu~^^-hx^^ 0 
111] \s — & km m--x*>z m&\z.&tt z> ^ is^ior^vay 

II 3] g3*Jg«Oj|J»»*IRSJ«»l©^n*/Tt7 o-f T-fcSo 30 

114] i3iiw^ii»^*iwa»^i^sn^/Tt7 h^fe^ 0 

116] m 3 n js #j <d ii # « # a jr $p & m <o m ti & * -r ^ o - ^ — b -e $> 5 0 
11 7] ga^^ft^ftfit sa^tsRo^fr t ^^a**^tit*s>s 0 

11 8 ] SE*ft*©B81^S:*tRWB-e«)5 B 
11 9 ] tt*ft««)|B]ajtt«:«i-|ftWBI"C*>S. 
«F # © tt W ] 

1 u - if - y 

2 U - ^ &L 3£ S 

3 C C D # y 40 

4 M^MSI^S 

5 * # m m $i a 

6 ^iS^ffi^M 

7 «*e£«tti£B 

8 SB^i/-^ffljtPSl 

9 \" — * 7 — x * 

101 ^{#fcB1££H^I£ 

102 mitm r> iA^^s 

103 ttiftft:!^ 

104 If^I^ftili?^ 50 
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(START) 

JL 
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direction_C[i], direction_L[i] 
direction^], Recog_rVxy[i] 

MM 
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am 
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